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DYNAMICS  OF  A THREE  DEGREE  OF  FREEDOM  KINDIATIC  CHAIN 


I 

i 

Berthold  K.  "P.  Horn  | 

Ken-ichi  Hirokawa  ; 

Vijay  V.  Vazirani*  E 


ABSTRACT.  In  order  to  be  able  to  design  a control  system  for  high-speed 
control  of  mechanical  manipulators,  it  is  necessary  to  understand  properly 
their  dynamics.  Here  we  present  an  analysis  of  a detailed  mode!  of  a three- 
link  device  which  may  be  viewed  as  either  a "leg"  in  a locomotory  system,  or 
the  first  three  degrees  of  freedom  of  an  "arm"  providing  for  its  gross  motions. 
The  equations  of  motion  are  shown  to  be  non-trivial,  yet  manageable. 
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INTRODUCTION. 


In  this  paper,  we  analyze  the  relationship  between  actuator  torques  and 
joint  angular  accelerations  for  a device  with  three  rotational  degrees  of  free- 
dom, such  as  a "leg"  on  a locomotory  system  or  the  first  three  joints  of  a 
manipulator  or  "arm".  The  kind  of  analysis  we  present  here  leads  to  a clear 
understanding  of  the  effects  of  varying  Inertia,  joint-interactions  and  corl- 
olls  forces  and  forms  the  basis  for  simulations  of  such  systems  and,  most  Im- 
portantly, design  of  control  systems.  It  Is  likely  that  high  speed  control 
of  articulated  kinematic  chains  Is  not  possible  without  this  kind  of  detailed 
understanding;  conversely,  we  show  that  the  computations  required  of  such  a 
control  system  are  manageable. 

Initially,  we  restrict  our  attention  to  arrangements  with  no  offsets  be- 
tween links,  as  shown  In  figure  1.  Later,  we  consider  a more  realistic  case, 
the  MIT-Scheinman  electric  arm,  which  has  offsets,  as  do  many  practical  devices. 
Further,  we  model  links  as  thin  rods  and,  finally,  consider  more  complicated 
mass  distributions  at  the  end  of  the  paper. 

We  use  rather  primitive  techniques  In  order  to  avoid  possible  complications 
due  to  the  potential  difficulty  of  visualizing  angular  rotation  vectors  and 
components  of  Inertia  matrices.  The  same  results,  however,  could  be  obtained 
using  such  advanced  notions,  with  little  savings  In  effort  and  considerable 
loss  of  Insight. 
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NOTATIONAL  CONVENTIONS. 

The  links,  modelled  as  thin  ro^s  (see  figures  2 and  3).  are  numbered 
starting  with  the  base.  The  base,  link  0,  Is  rigidly  attached  to  a fixed 
Cartesian  coordinate  system  with  the  z>ax1s  pointing  up  through  the  column, 
link  1.  Joints  are  number  systematically,  with  joint  1 connecting  link  (1  - 1) 
to  link  1,  Thus  the  "hip"  or  "shoulder"  Is  joint  2,  vHth  the  "knee"  or 
"elbow"  being  joint  3. 

The  lengths  of  the  links  will  be  , Z2  and  with  masses  m^,  m2  and 
m^.  The  jo1nt>angles  will  be  called  0^,  62  and  0^  and  the  angular  velocities 
represented  as  0^,  §2,  and  0^.  At  times  It  Is  convenient  to  use  vector  nota- 
tion with 

0 ~ (01 , 02 » Qj) 

0 ~ (©1 , ©2 » Qj) 

Clearly,  0 together  with  0 specify  the  state  of  the  device  completely. 
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PLAN  OF  ACTION. 

We  treat  each  link  in  turn:  first,  we  calculate  the  velocity  of  each  point 
in  the  link  as  a function  of  the  joint-angle  rate;  second,  we  calculate  the 
total  kinetic  energy  in  each  link;  third,  we  calculate  the  torques  required 
to  support  the  motion  of  that  link;  and,  finally,  we  add  up  the  torques 
required  to  move  all  links  to  obtain  the  total  torque  that  must  be  applied  by 
each  actuator.  We  calculate  gravity  components  of  torque  at  the  very  end. 
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. REVIEW  OF  BASIC  MECHANICS. 

It  is  convenient  to  calculate  the  total  kinetic  energy  of  each  link  by 
dividing  it  into  infinitesimal  parts  and  integrating  along  the  length  of  each 
link.  The  kinetic  energy  of  a particle  of  mass  m moving  with  velocity  v is, 

of  course,  (l/2)mv2  . Thus  we  can  obtain  the  total  kinetic  energy  of  a link 
from 


K “ ^ / v^(s)  ds 

where  s is  distance  along  the  link  and  v(s)  is  the  velocity  at  a point  located 
a distance  s from  one  end.  Here  we  have  assumed  that  all  the  mass  is  concen- 
trated along  a line  and  is  distributed  uniformly  from  one  end  to  the  other 
with  linear  density  m/t.  More  complicated  models  require  more  difficult  analy- 
sis and  are  warranted  only  if  measurements  can  be  made  of  the  actual  mass-dis- 
tribution in  particular  limbs. 

We  find  that,  in  general,  v(s)  is  of  the  form 
v2(s)  = a + bs  + cs2 


Then  clearly 


K » [at  + b ^ + c 


CALCULATION  OF  ACTUATOR  TORQUES. 


The  easiest  technique  Is  based  on  the  Euler-Lagrange  formula, 

T s /3K  \ 3K 
i ' dt  ^30^^  " 30^ 

where  0^  is  the  angular  velocity 
" K 


and  T.  is  the  torque  required  at  joint  i to  support  the  motion.  K is  the 
kinetic  energy.  This  may  look  complicated,  but,  in  fact,  is  very  convenient. 
In  general,  if  the  potential  energy  term  is  added  in,  this  calculation  leads 
to  n equations  for  a device  with  n degrees  of  freedom. 


Here  T^,  the  actuator  torque  required  at  joint  i,  is  made  up  of  three  components. 
The  first  is  the  gravitational  term  obtained  from  the  potential  energy  P, 


The  second  term  is  a sum  of  products  of  inertias  and  angular  accelerations 
ej,  where 
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d2 

® j * dts-  ® j 

This  term  is  thus  composed  of  the  inertial  forces  needed  to  accelerate  the 
links  along  the  desired  trajectory. 

The  third  term  is  a double  sum  of  velocity  product  terms  and  constitutes 
the  torque  required  to  balance  Coriolis  forces;  these  include  the  centrifugal 
forces.  Note  that  all  three  kinds  of  coefficients  G.,  and  C.  .|^  are 

1 *1 J I J K 

functions  of  the  configuration,  e,  only,  where 
6 * (0^,  ©2 » 0^  •••  ^ 

That  is,  they  do  not  depend  on  joint  angle  velocities  (or  accelerations).  In 
fact,  we  find  that  these  terms  are  polynomials  in  link  lengths  and  sines  and 
cosines  of  the  Joint-angles. 

It  is  convenient  to  think  of  the  total  kinetic  energy  of  the  device  as  a 
sum  of  the  kinetic  energies  of  the  individual  links, 

n 

K * z K. 

J - 1 J 


and  to  calculate  the  total  torque  required  of  a particular  actuator  as  a sum  of 
components,  each  obtained  by  applying  the  Euler-Lagrange  equation  to  a component 
of  the  kinetic  energy. 


n 

^ J = 1 ’J 


i 
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THE  UPRIGHT  COLUMN. 

If  Me  model  this  link  as  a thin  rod, 
pede  accelerations  about  Its  axis  at  all. 
a cylinder  of  uniform  mass  distribution, 
mass  m^.  It  has  Inertia 

2 

m,R 

T _ I 


It  will  have  no  Inertia  and  not  1m- 
It  Is  more  realistic  to  model  It  as 
If  It  has  height  H,  radius  R and 


To  Introduce  the  techniques  used  later  for  the  other  links,  we  calculate  this 
from  first  principles.  The  volume  of  the  cylinder  Is 

V = hR2h 

Consequently,  Its  mass  density  Is  m^/(iTR2H). 

Now  consider  a cylindrical  shell  of  thickness  d^  at  distance  s from  the 
axis  as  In  figure  4.  It  has  mass 

/4m  - HL  2irsH  j- 

Particles  in  this  shell  move  with  velocity  se^  when  the  column  rotates  at  angular 
rate  e^.  The  kinetic  energy  of  the  cylindrical  shell  is  then 

I (dm)  [se^]^  “ 9^  ds 


Integrating  over  the  whole  cylinder  we  find  the  total  kinetic  energy  is 
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1 


K,  s3ds4(!fi)  5| 

The  term  * mR2/2  is  the  inertia  of  the  upright  column,  link  1,  about  its 
axis  of  rotation. 


i 


i 

i 
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ACTUATOR  TORQUES  REQUIRED  TO  SUPPORT  MOTION  OF  LINK  1. 

We  are  now  ready  to  apply  the  Euler-Lagrange  equations  to  find  the  required 
actuator  torques. 


T = -£.  ( — 1 
'll  dt 


) - 


3K^ 


where 


3K^ 


and 


3K^ 
3S  » 


SO 


'll 


_ d 


or 


^11  = 


h ®1 


This  rather  obvious  conclusion  shows  that  we  need  only  an  inertial  torque  to 
support  this  motion.  No  other  joints  are  affected. 
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THE  SECOND  LINK. 


Link  2 is  modelled  as  a thin  rod  of  mass  m2  and  length  (see  figures  5 
and  6).  To  compress  long  expressions  we  adopt  a convention  for  trigonometric 
terms: 


c^  = cos(e^.)  s^.  = sin(0^) 


and 


c^.j  = cos(e.  + 0j)  s^j.  = cos(0^.  + Oj) 
The  infinitesimal  particle  i of  length  ds  has  mass 


First  we  determine  the  velocity  of  this  particle;  it  can  be  found  by  differenti- 
ating its  position  with  respect  to  time.  Let  r = (x,y,z)  be  the  particle's  posi- 
tion in  reference  to  the  rectangular  coordinate  system  introduced  earlier.  If 
i,  j,  k are  unit  vectors  in  the  directions  x,  y,  z respectively,  then, 

- " ^ ^ (C2)k] 

Taking  the  derivative  we  get  the  velocity 

• • • • • 

V = s[(_s^e^S2  + c^C202)  1 + (c^0^S2  + s^C202)  4 (-5262)^] 


1 

t 0 

That  is. 


*^2  " 1 "’2  ^2  ^^2®1  ^ ®2^ 
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ACTUATOR  TORQUES  REQUIRED  TO  SUPPORT  MOTION  OF  LINK  2: 
First,  we  find  the  re<}u1red  derivatives: 

3^2  3K?  1 

>57  ■ “ 55;  • 5 "a'lCszVf  ] 


1 

^ ■ 3 injt|[s|e,]  ,nd  ^ ■jV|t»2] 


^36^^  * 3 * *2®1^ 


d 1 

^3^^  * 3 ">2^2^®2^ 


Finally,  using  the  Euler-Lagrange  equation. 


d 


36 


1 


3K, 

30 


2 1 • • 

2 ^2^2^^2^1  ^ 3s2C20^023 


d 

K <4) 


3K. 


30p  “ 3 "’2^2  ^®2  " ^2^2^?^ 
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The  tv«)  components  of  represent  inertial  and  corlolis  factors.  First, 
note  that  (l/3)m2Ji|s|  is  the  inertia  of  link  2 about  the  vertical  axis.  Multi- 
plying this  by  the  angular  acceleration  of  joint  1 gives  us  the  torque  re- 
quired to  produce  that  angular  acceleration.  The  second  term,  containing  a 
product  of  angular  velocities  is  a corlolis  force  factor  which  vanishes  when 
®1  * ®2  “ ® ®2  integer  multiple  of  90"  since 


2S2C2  * s1n{2e2) 


This  torque  term  has  to  do  with  the  change  in  kinetic  energy  when  the  inertia 
about  the  vertical  axis  is  changed  — it  is  the  term  which  speeds  up  a spinning 
ice  skater  when  (s)he  pulls  in  his(her)  arms  and  slows  him(her)  down  as  the 
arms  are  stretched  out.  It  shows  one  of  many  interactions  between  motions  for 
which  it  is  hard  to  get  an  Intuitive  grasp. 

I 

I 

I 

The  components  of  ‘^2®’^  ®ven  easier  to  understand.  The  first  term  is  just 
the  inertial  force  needed  to  accelerate  link  2,  since  the  Inertia  of  link  2 
about  joint  2 is  simply  (l/3)m2t|.  The  last  term  is  a centrifugal  force  term, 
which  again  is  zero  when  $2  is  an  integer  multiple  of  90".  It  represents  the 
tendency  for  the  second  link  to  become  horizontal  as  a result  of  rotation  about 
the  vertical  axis. 
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THE  THIRD  AND  LAST  LINK. 

Link  3 is  modelled  as  a thin  rod  of  mass  m^  and  length  (see  figures  7 
and  8).  The  location  r of  the  Infinitesimal  particle  of  length  ds  and  mass  dm 
Is  found  first,  where 

•"a 

dm  * ^ ds 

We  find  that. 


r - c^(t2S2  + s S23)i  + ^ ^ ^“'2^2  * * ^^23^  - 

Differentiation  with  respect  to  time, 

y “ C-Siei(t2S2  + s S23)  + 0^(^20202  + s 023(62  + 63))]  1 + 

^‘^1®1^V2  ^ *23^  ^ ^1^V2®2  ^ ‘^23^®2  * 

C-Wz  - * »23<®Z*»3>3!J 

Then, 


y2  ■ y . y B 

0f(i2S2^sS23)^+  (V2®2  * * '23<»2  * »3'''  ♦ 
^"^2*2®2  ‘ * *23^®2  * ®3^^^ 
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v2  * (t|8|  + 2l^S^S^^S  ♦ s|3S2)  42  + 42 
(02  + s2 

Since  C2C23  + S2S23  » cos(e2  - (62  + 63))  - C3. 

So, 

y - 1 /’^3  2 "*3  W 

3 ■ 2 y 0 ''  * 

becomes 


K3  ■ p-  ♦ t2*3'2'23  ♦ r 'l3>®f  ’ 


*"3 


That  is. 


T ^®2 


h * r * Wzhd  * T *13^®!  ^ 


(i|  + ^2^3  ■*‘3^^®!  * 

Zll 

* “T^  ®2®3 


(/)  5|] 


iMSf-'.i-'-- 


+ 2£2C302(e2  + 63)5  + 


£|e|  + 2’223C3e2(02  ■*■  ^3^  ■*■ 


This  finally  is  the  kinetic  energy  link  3! 
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ACTUATOR  TORQUES  REQUIRED  TO  SUPPORT  MOTION  OF  LINK  3. 


A 3K-  3K, 

T _ ^ / 3\  3 

13  dt  '36^ ' " 30^ 


^13"  2 ^2*’3^2®23  3^  ^23^  ®1  ''' 


2(2&|s2C2  + ^2^3^‘^2*23  ^2‘^23^  “5^  ^23^^23^  ®1®2 


Q • • 

2^*^2*'3^2‘^23  ■*■  IT  ^23*^23^  ®3®1^ 


A 3K- 

T _ i\  3 

23  dt'3?^^  “ 302 

m,  i\  2i\ 

^23"  C2(^  + ^2^3^3  3~^  ®2  ^ ^^2^3^3  ^ 3 ) ®3  “ 


ct^ 

-{2^2V2  * ^ ^Z^ZZ^  * ^23^23^  H " 


■24242020203  ■ ^2^3^3^^ 


A 3K,  3K, 

^33'  ^957’  ■ ^ 


^33“  2~  f^^2^3‘^3  ^ T"^  ®2  “3“  ®3 


^^2*'3^2‘^23  '*’  “3^  *23^23^  ■*■ 


^^2^3^3^  ®2^ 
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GRAVITATIONAL  TORQUE  COMPONENTS  IN  SIMPLE  CASE. 

If  gravity  acts  along  the  z-axis  and  has  magnitude  g,  then  the  potential 
energy  of  the  device  can  be  found  easily  from  the  vertical  positions  of  the 
centers  of  mass  of  the  two  links. 

^2  *-3 

^2  ~ 5 ^2  ^3  ~ (^2,^2  ^ ^23^ 

So  the  total  potential  energy  is 

^2 

P “ 9[m2  ^ ^2  ^ m2(«,2C2  y'  ^23^^ 

So  the  torque  components  are  simply 


These  components  may  simply  be  added  to  the  components  already  found  for  inertial 
and  Coriolis  torques. 
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GRAVITY  COMPENSATION  IN  GENERAL  CASE. 

The  position  of  the  center  of  mass  of  link  2 is 

1^9=  (g^. 92*93)  is  the  vector  of  gravitational  acceleration,  then  the  po- 
tential energy  is 

^2 

^2  " '^-2  ■ 9^'"2  " ■"’2  T *^‘^1^2^!  ^ ^1^232  ^ *^2^3^ 

Similarly,  the  position  of  the  center  of  mass  of  link  3 is 

^ 9*  i, 

1^3  " ^ 2 ^23^^  ^ Si(f.2S2  2 ^23^'i  ^ (^2^2  ^ 2 ^23^^ 

P3  = -(fa  • g)ni3  = 

■'"3^‘^1^^2^2  * 2^  ^23^^1  ^ 5i(^2^2  * 2^  ^23^^2  ■*■  ^^2*^2  * T ^^23^53^ 

The  total  potential  energy  is  the  sum  of  Pg  and  P^.  The  gravity  compensation 
torques  can  be  found  from  P by  differentiation. 
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3P  ^2 

^lg“  ■ ^ ■ s^(-m2  ^ Sg  - m3(^2^2  ''■  T~  * 

if  it 

C]  (n)2  ^ Sg  + nij  {^2^2  ^ 2~  ^23^  ^®2 

\g~  ■ 30^  ~ T'  ^2*  "’3^*'2^2  ^ ‘^23^^^!  * 

Y~  ^2  ^ '**3(*'2^2  ^ ^ ^23^ ^^2  ^ 

£ Jt 

(-m2  Y'  ^2  ~ "'3^*'2*2  * ^ ^23^ ^^3 

3P  ^3  ^3  ^3 

^3g^  ■ 36^  “ '"3^^1^2“  ‘^23^^!  * ^1^^  ‘^23^^2  ‘ T'  ^23  ^3^ 


I 

! 


I 
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MASS  CONCENTRATION  AT  THE  END  OF  LINK  2. 


Let  there  be  an  additional  mass  attached  at  the  end  of  link  2.  Its  velocity 
squared  is 


V2  = q [S2  02  + 02] 


4 = ^ M2  t2[s2  02  + 02] 


So  the  torque  components  would  come  to 


Tj  = [s|e'^  + 2s2C2e^02] 


T^  = M2t|[e2  - 520202] 
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MASS  CONCENTRATION  AT  THE  END  OF  LINK  3 — LOAD  CARRIED. 

Let  there  be  an  additional  mass  attached  at  the  end  of  link  3.  Its 
velocity  squared  is 

v2  = + ji^s23)202  + + 2ji2*.3C302(e2  + §3)  + ^3^^ 

So, 
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; i 


I 


I 


» 

j 


I 


i 


— = M2[<.3(«.2C3  + *■3)  02  *'3®3^ 


d 3Ki 

+ *’3023^^®!  '*'  ^^*^2^2  ’*’  *’3^23^^*’2‘^2®2  '*'  ^3^23^®2  * ®3^^®1^ 


d ^*^3 

M3[(«.|  + 2i.2^2^2  * ®2  '’’  ^3^*'2‘^3  '*’  ^3^  ®3  " 

2jl2*’2S302®3  “ ^2*^3^3®P 


d ^“^3 

""  ^3^*'3^*'2^3  * *'3^'®2  *'3®3  ' *'2*'3^3®2®3^ 


T^  = M3C(j,2S2  + '•3^23^^®!  '*'  '*'  *'3^23^®1®2  '*’ 

2^3023(^252  ■•■  *■3^23^  ®3®1^ 


^2  " ^3  ^^^2  '*’  ^*'2*’3®3  ^ *'3^®2  ''’  *'3^*^2^3  ^ *'3^  ®3  ' 


(^2^2  '*’  ^3^23^^*^2^2  ^ ^3®23^^  ” ^*'2*’3^3®2®3  ” *^2*^3^3^3^ 


^3  ^^3^^3^^2‘^3  '*’  ‘^3^®2  '*’  ^3'®3  " '^3®23^^2^2  '*’  *^3^23^^  '*’  '^2'^3^3®2^ 

These  expressions  can  be  used  to  calculate  additional  torques  required  to  support 
the  iTiovements  of  a load  carried  by  the  third  link. 


1 

I 

i 

\ 
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GRAVITY  COMPENSATION  FOR  THE  MASS  CONCENTRATIONS  AT  THE  ENDS  OF  LINK  2 AND 
LINK  3. 

' 

The  position  of  the  mass  concentration  at  the  end  of  link  2 is 

and  its  potential  energy  is 

P2  = -(^2  ' ?^”2  ' ■”2^2^‘^1^29i  * ^1^232  *^2^3^ 

Similarly,  the  position  of  the  mass  concentration  at  the  end  of  link  3 is 

-3  “ Ci^*'2^2  *'3^23^3  ^ s^(*,2S2  + *•3523)'?  * ^^2^2  * *^3‘^23^' 

and  its  potential  energy  is 

^3  “ ‘^'3  ■ ?^^3  ^ "^3^^!  ^*’2^2  * *^3^23^^!  ^1^^2^2  * *'3^23^^2  * 

(^2*^2  * *'3^23^^3^ 

The  net  potential  energy  of  the  mass  concentrations  is 

p ' = p ' -f  p ' 

K ^2  3 

and  the  gravity  compensation  torques  for  the  three  links,  on  account  of  the 
mass  concentrations,  are 

Ig  “ ■ ae^  * *1^'^2*^2^2  " ^3^*2^2  *^3^23^^^!  * 


^1 ^^2^2^2  ^ ^3^^2^2  ^ ^3^23^ ^^2 
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^2g  “ ■ 302  “ * •^3^V2  *■ 

Sl^^2^2‘^2  ^ ^3^*2‘^2  * *3*^23^ ^®2 
(^2*’2*2  ^3^ *"2^2  *”3^23^  ^^3 

I 3P' 

^3g  " ■ ^ “ ^^V]‘^23^]  ^ V]^23^J 


,C23))g,  + 


■ ^3^23^3^ 
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I 

i 

•THREE  DEGREE  OF  FREEDOM  DEVICE  WITH  OFFSETS. 

In  some  manipulators  and  legs,  trade-offs  In  the  mechanical  design  dictate 
a geometry  with  offsets  between  links  as  seen  In  figure  9,  for  example.  Smaller 
packaging,  better  strength  and  larger  range  of  motion  can  be  achieved  this 
way  In  return  for  a small  Increase  1n  complexity  of  control.  The  MIT-Scheinman 
electric  manipulator  Is  an  example  of  a device  with  offsets.  It  will  be  found 
that  only  a few  extra  terms  appear  In  the  expressions  for  the  torques  required 
of  the  actuators.  Obviously  the  torques  required  to  support  the  motions  of 
link  1,  the  upright  column,  do  not  change,  so  we  start  with  link  2. 
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THE  SECOND  LINK  IN  A DEVICE  WITH  OFFSETS. 

The  position  r of  a particle  on  the  second  link  can  be  found  by  considering 
figures  10  and  11. 


r « [sc^S2  ■ ^2^1^^  f”l^2  * *2^1^^  ^ ^^^^^2^!^ 

Differentiating, 


y»  [-ss^e^S2  sc^c2e2  - «2^1®1^! 

[^^1®1^2  ^ sSiC202  ~ ^2^1®!^-  t"^^2®2^- 


So, 


v2  * s2^2q2  + (SC202  - <52®!)^  * 

v2  » (6^  + s2s|)0^  - 2s62C20i92  ^ 


The  kinetic  energy  can  be  found  by  Integration 


V r:  ^ ?, 


1 2 • . . *’5 

•^2  = 2 "’2^^®2  F *2^®1  ■ V2‘^2®1®2  * T 
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ACTUATOR  TORQUES  REQUIRED  TO  SUPPORT  MOTION  OF  LINK  2. 


^*4  ^^2  . 

ia^  * ° iej  * T *-1"  * V2^2®1®2^ 


3 ^2  0^2 


^ ^ [2(62  + y s^)  0,  - fc2fi2C2®2^ 


3K2  m2  , 2il 

^ = 2"  [”^2^2Vi  ■*■  ~ ®2^ 


d ^<2  m2 


e.2 

^2 


4.2 


dt  ^317^  “ r ^^^^2  * T ^Ph  - Hh^ih  * — ^2‘=2h®2  ^ ^2^2"2®P 


d ^*^2  '"2  . ^^2  •• 

d^3^^  ~ T'  f'^2'^2‘^2^1  '*'  ~ *®2  ■*■  *-2^2^2S®2^ 


Finally, 


12  dt  '3?7^  ~ 36^ 


"'2  ^2  ..  ..  ^^2 

^2  * F"  [^^^2  * ~f  *2^  *®1  " '^2^2‘^2*®2  * ~T  *2^2h®2  ^ *'2*^2^2H^ 


j 3K«  dKm 

^2*  - 307 


"'2  ••  ^*^2  ~ • 

^2  * 5~  [“4242^2®!  * ~T~  ®2  ” ~T~  ^2^2®!^ 
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THE  THIRD  LINK  IN  A DEVICE  WITH  OFFSETS. 

The  position  r of  a particle  in  the  third  link  can  be  found  from  figures 
12  and  13. 


r = [(t2S2  ^ s ^23^*^!  ■ '^3^1^!  ^ 

C(V2  ^ ^23^^1  ^3*^1^^ 

[t2C2  + s C23]k 

Differentiating, 

y " [“(t2S2  + s ^23^^1^1  " *^3*'1®1  * (*'2*'2®2  ^ ^*'23^^2  ^ ®3^^^]3i  "*■ 
[(*^2^2  ^ ^ ^23^^1®1  " *^3^1®!  (^2^2®2  * ^^23^®2  * ®3^^^1^'^  '*’ 

C“^2^2®2  ~ ^ ^23^®2  ®3^^~ 

So, 

v2  = y . V = (£2S2  + s 523)202  + [-636^  + 42^2^2  ^ 5‘=23^®2  ®3^^^ 

[“^252^2  ” ^ ^23^^2  ®3^^^ 


+ 
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That  is. 


,2  » (I2S2  ♦ S S23)2e2  t + t|e|  ♦ * «3>'  ' * 


v2  = (42s|  + zti^s^s^^  + 52523  + 62)02  - 263(J2C2  + sc23)e,02  + 

(i|  + 2s)i2C3  + s2)  02  + (2S42C3  + 2s2)0203  + (s2)^  - 2063023030^ 


- f*'3  l"l3 

■ i „ 21, 


v2ds 


fn^ 


£2 


K3  = y^U-2^2  * *'2*’3^2^23  ''’3  ^23  '*'  ^3^  M " ^3^^^2^2  * ^3^23^®1®2  * 

2.  2^^ 

(t|  + «.2«^3C3  + ^)e2  ■'■  (*'2*'3^3  * “3^^®2®3  * ^3~^®3  " ^3^*'3‘^23^^*®1  ^ 
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PARTIAL  DERIVATIVES  NEEDED. 

3K, 

— - = 0 

38^ 

3 K3 

^ = 2“  + ^2^3^‘^2^23  ^ ^ “T  ^23*^23^®! 

'53^^V2  * '^3^23^'®1®2  ^ ^3V23®3®1^ 

^*^3  '"3  2^3 

^ = 7-  C(V3V23  “ ®23^23^H  * ^3^V23^®1®2  ‘ 

^^2*'3®3^®2  ' ^*'2*'3^3^®2®3  ''’  '^3^*'3^23^®3®1  ^ 

3K3  m-  12 

3§7  * ^ [2(£2s2  + ^2*352523  + y 5^3  + «|  )*e^  - 

^^{Zl^Cz  * ^3‘^23^®2  ■ '^3^^3^23^S^ 


i 
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ACTUATOR  TORQUES  REQUIRED  TO  SUPPORT  MOTION  OF  LINK  3. 
^13=  ^ 


^13"'  2^  C2(a|s|  + *2*'3^2^23  3^  ^23  * '*3^*®1 


'^3^^*2‘^2  '*'  *’3‘^23^®2  " *3^*'3‘^23^*®3  '*’ 


ZiZl^s^^Z  * *'2*'3^^2^23  '*’  ^2^23^  3 ^23*^23^  S®2  '*’ 

63(2^252  + *^3^23^®2  '*’  ^'^3*'3^23®2®3  '*’  **3^3^23^  ^ 


243033(^252  ■•■  3 S23)  636^] 


j 3K*  3Ko 

^23*  - 4 


T23=  2 [-«3(2t2C2  + £3023)63  + 2(£|  + 62^3^3  * 3^®2  '*' 

242  24| 

(4243C3  + -j-re’j  - ■*■  ^2^3  ^^2^23  '*'  ^2*^23^  '‘‘  1“  ^23^23^H 


2(424353)0263  - (424353)^] 


• • • • 

Note  the  cancellation  of  terms  in  0^62  and  630^, 
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T = 1-  r 3 

33  dt  ~ 


_'"3 


Zll 


^33^  2 ^"'*3^^3‘^23^®*1  ^^2*'3‘^3  * “3^^*®2  * ~3^^*®3 

'*'  1“  ^23^M  '*’  ^^2*'3^3^*®2^ 


2t.l 


Note  cancellation  of  terms  in  0102.  0263  and 


TORQUES  REQUIRED  TO  SUPPORT  GRAVITATIONAL  FORCES. 


The  center  of  gravity  of  link  2 is 


r2  * ^2-  "1^2  - ^ ^1^2  ^ «2"l^J  ^ 


Its  potential  energy  is. 


it  Jt 

^2  ~ ”^***2  * ^1^2  ” ^2^1  ^ ^2  ^1^2 
tn 


Similarly,  the  position  of  the  center  of  gravity  of  link  3 is 

it  £ 

-3  * [(*-2^2  ^ T~  ^23^^!  ’ '*3^1^!  * ^^*’2*2  * 2~  ^23^^1 


C^2^2  2 ^23^^ 


Its  potential  energy  is 


P3  » -(r3  . g)m3 

^3  ‘ ■ "’3tt^*'2*2  * F"  ^23^*^!  " *3^1^^!  * t^V2  * ^ 
*3^1  i^2  ^*^2*^2  'T  ‘^23i^3 

The  total  potential  energy  is  the  sum  of  ^3* 
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Torques  required  then  are: 


Ig  ~ ■ 80^  “ g-|[-m2^2  ^1^2  *^2^1^  ■ '''3^*'2^2  2~  ^23^^1  " 

V3^1^  + g2['n2^^  ■ "^2^1^  ■*■  '"3(‘^2^2  T ^23^  ‘ 


V3"l^ 

■ = 9i[m2  / c^C2  + m3(t2C2  + ^ 023)0^]  + 

g2*-'"2  2“  ^l‘^2  ^ '"3^V2  * T '^23^^!^  * 

^2 

93^’"'2  2~  ^2  ~ '"3 ^*"2^2  2“  ^23^^ 

3P  ^2  ^3  ^3 

■ iej  “ 9i^'"3  F ^23^1^  92Cm3  j-  C23S^]  + g3[-m3  j-  $23] 
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MASS  CONCENTRATION  AT  THE  END  OF  LINK  3 - LOAD  CARRIED. 


v2  = (*,2s2  + 21^1^52^22  * ^3^23  + «3)0f 

263(11202  + ^3^23)61^2  ^^2*'3^3  ^ *'3^®2  * 

(2*’2*'3C3  ■*■  ■'■  ^3^3  " ^*'3^3‘^23*®3®1 


K-  = i M3V2 


3K' 

397=  0 


3K* 

^ M3[(«,2S2  + ^3^23^^^Z^Z  * *'3‘^23^H  ‘^3^V2  * *’3^23^®1®2 


V3^23®3®1^ 

3K' 

36^  = M3[(<,2S2  + *-3523^ *'3^23®!  ^ ®3*'3^23S'®2  " *'2*'3^3^®2  ^ ®3^®2  * 
*'3®3^23®3®1^ 


3K, 

^ = M3[(a2s2  + 2^2^352523  + ^523  + 62)e^  - 63(6203  + 13023)62  - 

*3^23^3^ 

3K: 

3?7  “ ”3^“^3^  V2  * V23^^1  * ^^2  * ^*-zh^3  * ^V^Z  * 


^*'2*'3‘^3  '*’  *'3^®3^ 
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3K' 

3^  “ ”3^®3^3V23®1 


+ (^12^3^3  + <^5)02  ■*■  ^3^3] 


d ^4 


* 4^ ^*'2^2  ■*■  ^444^23  * *^3^23  * " 

* ^3‘^23^*®2  ■ '^3*'3^23*®3 


2(*'2^2  '‘’  *'3^23^^4‘^2®2  '*'  *’343^4  '’’  * 

®3^44®2  ■*■  *■3*23^4  * 4^ * 

’^3443^4  '*’  ®3^®3^ 

= M3[(*,|s2  + 2j!,2«.3S2S23  + ^\^2Z  '*’  *^3^®!  " 

4^V2  ^3^23^4  ‘ 4^3'^23®3 

2(*'2®2  '*’  4^23^ ^4*^2  '*'  *'3*^23^®! 4 
^*■2*2  ^ ^3^23^'*3®2  * 

'^3*'343®3  '*'  ^^*"2^2  '*’  4^23^*'3‘^23®3®1 


■ »'3C-'3(*2'2  * ‘3‘23>®1  * <*2  * ^‘2‘3'3  * '3>«2  * 
<‘2‘3‘=3  * ‘l>*3  * *3<*2*2«2  ^ *3*23<*2  * *3»®1 
-2^2^352*6203  - ^2^353^3 

“ ^3^‘^3^*'2‘^Z  '*’  *’3^23^*®!  ^ * ^3^*®2 

^*'2*'3^3  * *'3^®3  ^ *3^*'2^2  '*’  *'3^23^  *®1®2  ‘ 
^*'2*'3^3®2®3  “ V3®!  ■‘'  '^3*'3^23®3®1^ 


d ^*^3 

3t^30^^  ' ^3^"^3^3‘^23®1  * ^^2^3‘^3  * *3^*®2  ■*■  *3®3  * 


'^3*'3^23®1®2  " *'2*'3^3®2®3  * ^3*^3^23®3®1 


■ ^3^*2*2  '*'  ^^2^3^2^23  ''’  *’3^23  ''’  ^3^*®1  ' 

®3^*^2^2  '*’  ^3^23^^2  " '^3^3‘^23®3  '*’  ^^*^2^2  '''  ^3*23^ 
^*•2*^2  '*’  *^3*^23^®1®2  * ^*'2*2  '*’  ^3*23^*3^  ''’ 
^*3^2*23®2®3  * ®3*^3*23®3  ^ ^*^3^23^ ^2*2  * *3^23^^®! 
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^2  “ '^3^"*3^V2  '^3‘^23^’^1  ■*■  ^^2  * * *^3)^2  ^ 

^3^^2^3  ^3^®3  ~ (^2^2  ^3^23^ ^^2^2  "*"  ^3^23^^!  ” 

2il2£2^3®2^3  ” ^2^3^3®3 

^3  * ”3^“'^3V23®1  ^ ^3^V3  * ^3^®2  ■*■  ^3*®3  " ^3^23  ' 
(^^2^2  ■'■  ^3*23^®1  * *^2*'3*3®2^ 
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GRAVITY  COMPENSATION  FOR  LOAD  CARRIED. 

The  position  of  the  load  is, 

-3  “ ^^^2*2  * " ^3*1^!  * ^(^2^2  * ^23^^!  ^ 

630^ ]j  + + t3C23]k 

The  potential  energy  is, 

^3  = • 9)M3  = -M3[g^(()i2S2  + £3533)0^  - 638^)  + 

92^V2  ^ V23^^1  ^ 93^V2  ^ ^23^^ 

^Ig  = M3{.g^[(£2S2  + £3S23)s^  + 630^]  + 

^2g  “ ”3^9i^V2  * ^23^*^!  92^  V2  ■*■  V23^*l  * 

93^^2*2  * ^3^23^ 

Tag  = Ma  ^ 9i"3‘^23‘=1  * 92"3'=23*1  " 93"3*23> 


i 

• J 
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SUfflARY  AND  CONCLUSIONS. 

We  have  shown  that  detailed  analysis  of  the  dynamics  of  mechanical  mani- 
pulators is  feasible  and  leads  to  complicated,  but  manageable  equations.  Such 
equations  may  be  used  in  the  simulation  of  such  devices  or  directly  in  control 
systems  based  on  open-loop  computation  of  required  joint  torques.  Simulations 
may  be  used  in  the  design  or  analysis  of  traditional  control  systems,  which 
can  maintain  stable  control  only  for  low  speeds. 

New  kinds  of  control  systems  can  be  envisaged,  where  negative  feedback  is 
only  used  to  account  for  small  errors  which  come  about  because  of  differences 
between  the  actual  device  and  the  mathematical  model  used  in  deriving  these 
equations. 

We  have  derived  the  necessary  equations  for  devices  with  rotational  de- 
grees of  freedom  and  no  offsets  (pages  10,  13,  19).  Compensation  for  gravita- 
tional forces  have  also  been  calculated  for  arbitrary  orientation  of  the  de- 
vice (page  22)  as  have  the  torques  required  to  move  a load  carried  at  the  tip 
of  link  3 (page  25).  Finally,  compensation  for  gravitational  forces  on  this 
extra  load  were  considered  (page  26). 

The  same  calculations  were  then  repeated  for  a device  with  offsets 


(pages  10,  29,  34,  35). 
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